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SUMMARY 


This semi-annual report presents the research results from the research grant entitled ” Active 
Control of Robot Manipulators,” funded by the Goddard Space Flight Center , under the Grant 
Number NAG 5-780 , for the period between February 1 , 1989 and August 1 , 1989 . 

In this report , we present the development of a joint-space adaptive scheme that controls the 
joint position of a six-degree- of -freedom (DOF) robot end-effector performing fine and precise 
motion within a a very limited workspace . The end-effector was built at NASA to study au- 
tonomous assembly of NASA hardwares in space . The design of the adaptive controller is based 
on the concept of model reference adaptive control (MRAC) and Lyapunov direct method . In 
the development , we assume that the end-effector performs slowly varying motion . Computer 
simulation is performed to investigate the performance of the developed control scheme on po- 
sition control of the end-effector. Simulation results manifest that the adaptive control scheme 
provides excellent tracking of several test paths. 



1 INTRODUCTION 


Recognizing the fact that performing operations in space is dangerous, NASA has paid its 
attention to the research of telerobotics which is the combination of two different concepts, 
teleoperation and robotics [1]. Telerobotic operations can be executed either in a traded control 
mode (serial operation) or in a shared control mode (parallel operation). In the traded control 
mode, using teleoperation the human operator performs some portion of a task and then let 
the telerobot perform some other portion of the task autonomously while on the other hand, 
the human operator and the telerobot perform portions of the task simultaneously in a shared 
control mode. In either modes, successful robotic tasks require that the motion of the telerobot 
be controlled precisely. A telerobotic system generally consists of a master arm and a slave arm. 
It has been proposed [2] that a light and compact 6 DOF end-effector be built and mounted to 
the slave arm to autonomously perform fine and precise motion during the traded mode of the 
telerobotic operation. In this report we present the development of a joint-space adaptive control 
scheme for controlling the end-effector motion by using the concept of MRAC and Lyapunov 
theorem. 

When a dynamic model can accurately represent the real end-effector dynamics, then com- 
puted torque [3] scheme whose development is mainly based on the dynamic model, can be 
employed to control the end-effector motion. Using the above scheme, time-varying controllers 
can be designed so that disturbances are minimized and excellent tracking performance can be 
achieved. Since it is relatively difficult, if not possible to derive an accurate dynamic model for 
a robot end-effector, the computed torque scheme is not feasible. The urgent need of a control 
scheme that is able to effectively react to the presence of nonlinearities and uncertainties in 
robot end-effector dynamic model and payloads has motivated the research of adaptive control 
schemes, according to a recent survey [4]. MRAC method and Lyapunov theorem function were 
employed by several researchers to design adaptive controllers for cartesian- and joint-space tra- 
jectory control, which was proved to provide global stability [5,6]. Lim and Eslami [7] considered 
the design of robust adaptive controllers. Adaptive force control problem was investigated by 
Daneshmend and Pak [8] for a cutting problem. In [9] Houshangi and Koivo designed an adap- 
tive force-position controller with self-tuning in cartesian space by using eigenvalue assignment 
method and minimization of a quadratic performance criterion. Recently, Seraji [10] presented 
the implementation of adaptive force and position controllers for robot manipulators within the 
hybrid control structure using an improved MRAC. The problem of hybrid control of force and 
position was also considered by Nguyen and Pooran [11]. 

In this report, we first describe the structure of a 6 DOF end-effector built at NASA to 
study telerobotic assembly. We then present the derivation of a joint-space adaptive control for 
controlling the end-effector motion. After that, the developed control scheme will be applied to 
control the planar motion of a 2 DOF end-effector built in our robotic laboratory. Discussion 
of the simulation results and recommendation for future research direction will conclude the 
report. 

Notations used in this report are listed below 

• M r : transpose of the matrix M 

• 0 n : (nxn) matrix whose elements are all zero 

• I n : (nxn) identity matrix 
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2 THE CKCM ROBOT END-EFFECTOR 


Most telerobotic assembly of parts such mating or fastening can be accomplished in a traded 
control mode [1] in which using the master arm, the human operator remotely moves the slave arm 
into the assembly workspace and then let a robot end-effector, mounted to the end of the slave 
arm perform the assembly task autonomously. In addition to the requirements of compactness 
and lightweight, the end-effector must be able to perform very precise motion within a very 
limited workspace. In order to study the feasibility of autonomous assembly of parts in a 
telerobotic operation, an end-effector whose size is about ten times that of the telerobot end- 
effector was designed and built at the Goddard Space Flight Center (GSFC) [12] and is currently 
located at the Center for Artificial Intelligence and Robotics (CAIR) 1 . As shown in Figure 1, 
the end-effector resembles the structure of the Stewart platform [13], and mainly consists of an 
upper payload platform, a lower base platform and six linear actuators. The movable payload 
platform is supported above the stationary base platform by six axially entensible rods where 
in order to provide the extensibility, the system uses recirculating ballscrews that are driven 
by stepper motors. The motion of the payload platform is produced by the combination of 
extending and shortening the actuator lenghts. Each end of the actuator links is mounted to 
the platforms by 2 rotary joints with intersecting and perpendicular axes. The end-effector has 
24 rotary joints, 6 prismatic joints, and 14 links including the 2 platforms and therefore has 6 
DOF, which can be proved by applying the number synthesis[2]. 

3 THE JOINT-SPACE ADAPTIVE CONTROLLER 

The robot end-effector described in previous section assumes a closed-kinematic chain mechanism 
(CKCM) which has been showed to possess high precision positioning capability [2]. Since 
CKCM end-effectors generally have a closed-form solution for its inverse kinematic problem, 
joint-space trajectory control scheme is proposed to control the end-effector motion so that 
time-consuming iterative computation of the forward kinematics in a Cartesian-space control 
scheme of CKCM end-effectors can be avoided. In other words, the error actuating signal 
to the joint actuators is computed based on the error between the desired variable and the 
actual variable. In addition, adaptive controllers are utilized instead of fixed-gain controllers in 
order to compensate the presence of nonlinearities and uncertainties in end-effector dynamics 
and payloads. Figure 2 presents the joint-space adaptive control scheme proposed to control the 
end-effector motion. As the figure shows, position sensors mounted on the end-effector actuators 
provide feedback information of the actual lenghts of the six actuators. The actual lenghts are 
then compared to the desired lenghts that are computed by the inverse kinematics from the 
desired Cartesian variables specified by the user or some path planner. The lenght difference 
will then serve as inputs to the adaptive controllers which in turn produce required joint forces 
for the actuators to track the end-effector along a desired trajectory. 

If we denote a (6x1) vector 1 composed of six actuator lenghts /,• for i=l,2,. . . ,6 such that 

l = (/i/ 2 ...k) T (1) 

J To test control schemes developed under a research grant with NASA/GSFC 
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( 2 ) 


as the joint variable vector, then the end-effector dynamics can be written as [11]: 

T(t) = M(l,i) 1(f) + N(l,i) i(0 + G(l,i) 1(f) 

where r(t) denotes the (6x1) joint force vector, M(l,l), the manipulator mass matrix is a 
symmetric positive-definite matrix of order (6x6), N(l,l) and G(l,l) are (6x6) matrices whose 
elements are highly complex nonlinear functions of 1 and 1. In the right-hand side of (2), if we 
neglect joint friction, the second term represents the centrifugal and Coriolis forces, and the 
third term the gravity forces. 

Consider now a PD time- varying controller defined by 

r(t) = K p (t) 1 e (t) + K d (t) i e (t) (3) 

whprp 

l e (t) = l d (t) - 1(f) (4) 

represents the deviation of the actual joint vector 1 (t) from the desired lenght vector 1 d (t). 
Furthermore, K p (t) and K d (t) denote the proportional and derivative adaptive controller gain 
matrices, respectively. 

Substituting (3) into (2) we obtain 

M l c + (N + K d ) i c + (G + K p ) l e = M i d + N \ d + G l d (5) 


where the dependent variables of the matrices and vectors have been dropped for simplicity. 
Defining a (12x1) state vector z(t) such that 


•(<)= [f(0 if(')] T 


( 6 ) 


converts (5) into the state space representation described by 


z(t) = 


o 

to 

o 

z(f) + 

06 

0 6 

06 

< 

i 

rH 

1 

A3 

a 4 

1 * 


u(f) 


( 7 ) 


where 

Ai = M -1 (G + K p ), A 2 = M- 1 (N + K d ), (8) 

and 

A 3 = M" 1 G, A 4 = M" 1 N, (9) 

and 

«(<) = [ff(0 £(<) iJw] • (10) 

In the framework of the model reference adaptive control (MRAC), the adjustable system is 
represented by Equation (7). The reference model specifies the desired performance of the end- 
effector in terms of l e (t) = [/ e i(f ) / e 2(0 • • • /e6(f)] T , which is the tracking error vector. Suppose the 
tracking errors / e ,(t) for i=l,2,. . . ,6, are decoupled from each other, and satisfy the relationship 


lei(t) + 2 ^ Ui i ei (t ) + uf l ei (t ) = 0 


( 11 ) 
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for i=l,2,. ..,6, where £, and u>j denote the damping ratio and the natural frequency of l e i, 
respectively. Then the reference model can be described by 


*m(0 — D Z m (t) — 


06 16 

-Dj — D 2 




( 12 ) 


where Di=diag(u;?) and D 2 =diag(2£,u;,) are constant (6x6) diagonal matrices, and 


*.(«)=[£(*) £(<)] r (w) 

with 

lm = (/el/ e2 ...U) T . (14) 

The solution to (12) can be found as 

z m (0 = exp(Dt) z m (0) (15) 


which under the assumption that the initial values of the actual and reference lenghts are the 
same, i.e., z m (0) = 0, yields z m (t) — 0. 

Now if the adaptation error vector e(t) is defined as 

e(t) = z m (t) - z(t), (16) 


then from (7) and (12), we obtain an error system defined as 


e(t) 


06 16 

-Dj -D 2 


e(t) + 


06 0 6 
Ai - Di A 2 - D 2 


z(t) 


06 06 06 

-A3 -A 4 -Ie 


u(t). 


We proceed to select a Lyapunov function candidate v(t) such that 

v(t) = e T Pe + tr [(A x - D X ) T J7 X (A X - D x )] 
+tr |(A 2 — D 2 ) T i7 2 (A 2 — D 2 )J 
+tr[A3 r i73A3] + tr[A 4 r J7 4 A 4 ], 


(17) 


(18) 


where <r[M] is the trace of matrix M, P and II i for i=l,2,. . . ,4, are positive definite matrices 
to be determined later. 

Taking the time derivative of (18) and simplifying the resulting expression yield 

v(t) = e T (PD + D T P)e 

+2tr [(A x - Di) T (m/ + iliAi)] 

+2tr [(A 2 -D 2 ) r (/2if + J7 2 A 2 )] 

-2 tr [a 3 t (/ 21/ - fI 3 A 3 )] 

-2tr[A 4 r (/2iI-J7 4 A 4 )] (19) 
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where 

fi = [P 2 P 3 ]*(<) = ~P 2 le - P 3 U (20) 


and P is denoted by 


P = 


Pi P 2 
P 2 P 3 


( 21 ) 


and it is remarked that e(t) = — z(t ) since z m (t ) = 0. 

We note that £, and u can be selected so that D is a Hurwitz matrix defined as a matrix 
whose eigenvalues all have negative real parts [14]. Therefore according to Lyapunov theorem, 
there exists a positive definite symmetric matrix P that satisfies the Lyapunov equation 


pd + d t p = -q, 


( 22 ) 


for any given positive-definite symmetric matrix Q. 
Now in (19), if we set 


and 

then (19) becomes 


n\ e T + J7i Ai = n\ e + j7 2 a 2 = o 


n\ / - j7 3 a 3 = n\ d - n 4 a 4 = o, 


v(t) = -e r Qe 

which is a negative definite function of e(t). Furthermore, from (23)-(24), we otain 


(23) 

(24) 

(25) 


a x = A 2 = -ii 2 - 1 «if, (26) 

and 

a 3 = iiz'nu 1 '; a 4 = n d l n\ d . ( 27 ) 

We already showed that P is a positive definite matrix. Now if we could show that J7, 
for i=l,2,. ..,4, are also positive definite matrices, then the error system described in (17) is 
asymptotically stable, i.e., e(t) -»• 0, or z(t) -*■ z m as t -*■ oo. 

As specified in previous section, since the telerobot end-effector will perform slow and precise 
motion, M, N and G are slowly time-varying matrices which can be considered as nearly 
constant matrices. In this case, from (8) and (9) we obtain 

Ai ~ M -1 K P ; A 2 ~ (28) 

and 

A 3 ~ 0; A 4 ~ 0. (29) 

Next substituting (28)-(29) into (26)-(27) results in 

M -1 k p = -i7- 1 /2i e r ; M _1 k<i = (30) 

and 

0~173 X /2l/; (31) 
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Now in (30), if we let 


III = — — M; J7 2 = M, 

<*1 «2 


where ai and a 2 are arbitrary positive scalars, then solving for K p and Kj, we get 

k p = oti&ij , 


K d = a 2 m' e . (34) 

We observe that in (32), 77 1 and 77 2 are positive definite matrices that can be considered as 
nearly constant because M, the end-effector mass matrix is positive definite and slowly time- 
varying. To satisfy (31), II 3 and II 4 should be chosen such that their determinants approach 
infinitive in addition to the positive definite property. Obviously II 3 and JT^could be selected 
such that they are diagonal matrices whose main diagonal elements are all positive and very 
large. 

We proceed to integrate both sides of (33) and (34) to obtain 


Kp(0 = Kp(0) + ar /‘( P 2 l e + P 3 ie)l Jdt 

Jo 

K d (t) = K d (0) + a 2 f\ P 2 U + P 3 ie)i^ 

Jo 


where K p (0) and K^(0) are initial conditions of K p (t) and K<*(t), respectively and can be set 
arbitrarily. 

Equations (35) and (36) provide the solutions for the controller gain matrices of the adaptive 
controller, which are based on the lenght errors and their derivatives. 

4 COMPUTER SIMULATION 

In order to examine the performance of the developed joint-space adaptive control scheme, we 
implement it on a 2 DOF end-effector that represents a special case of the 6 DOF end-effector. 
As Figure 3 illustratest the structured of the 2 DOF end-effector that is mainly composed of 2 
ball-screw linear actuators driven by dc motors and hung below a stationary platform via pin 
joints. Position feedback is accomplished by 2 linear voltage differential transformers mounted 
along the actuator links, Based on the diagram given in Figure 4, the cartesian position x and 
y expressed with respect to a reference coordinate system affixed to the stationary platform are 
related to the joint positions lj and 1 2 as follows: 

_ h 2 ~h 2 + d> 


U<Ph 2 - (/x 2 - / 2 2 + 
2d 
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where d is the distance between the pin joints hanging the actuators. Using Lagrangian formu- 
lation, we derive the following dynamic model of the end-effector: 

r(t) = M(l, i) 1(0 + N(l, i) i(<) + G(l, i) (39) 


where 

r(t) = (ri r 2 ) T ; 1 = (h h) T (40) 


where r,- and /,• denote the joint force to and the lenght of the ith actuator for i=l,2, respectively. 
In addition 


mi 0 


0 mi 


(41) 


N = 


0 
3 u 


3 u 
0 


G = (Gi G 2 ) T 


(42) 

(43) 


with 


and 


G i 


G 2 


-mgl m [2l\ui(li +/ 2 ) - / 2 u 2 ] 

+ / 2 / m + %hh) — him** 2 ] 


4 dl\l 2 u 


{ 


-rnjr/ m [2/^u 2 (/i + / 2 ) - /i« 2 ] 
-m x g[2u 2 ll{hl m + l 2 lm + 2/i/ 2 ) - / 2 / m u 2 ] 


4 dl\l 2 u 


) 


1*1 = 4 - li + d 2 \ 1*2 - I ] - 1 \ + d 2 \ 



(44) 


(45) 

(46) 


where m is the mass of the moving part of the link, m the total mass of the link, and l m the 
fixed lenght of the actuators and g the gravitational acceleration. 

In this study, we implement the developed adaptive control scheme to control the Cartesian 
position of the above 2 DOF end-effector tracking a desired path, which is shown in Figure 5. 
Three study cases are considered below where the performance of the adaptive control scheme 
will be compared with that of a fixed-gain control scheme developed earlier [15]. For the graphs 
given in Figures 6-8, solid line presents the desired path, dashed line and dashed-dotted line 
present the actual paths obtained from the adaptive and fixed-gain control schemes, respectively. 


4.1 Tracking a Straight Line 

The end-effector is controlled to track a straight line specified by y = x +42 [in cm]. Computer 
simulation results as shown in Figure 6 indicates that a steady-state error of 4mm in both 
horizontal and vertical axes exists in the case of fixed-gain control scheme while in the case of 
adaptive control scheme, the steady-state error is reduced to 1 mm in horizontal axis and to 0.1 
mm in vertical axis. In the case of the adaptive control scheme, it is interesting to note that 
at the beginning of the path, some minor deviation from the desired path occurs because the 
adaptive controller was trying to adapt to the end-effector dynamics. 
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4.2 Tracking a Sinusoidal Path 

In this case we study the tracking of a sinusoidal path described by the equation y = sin(2x — 
50) — 83 [in cm]. Simulation results presented in Figure 7 show that using fixed-gain control 
scheme, the robot tracks the desired path with a maximum deviation of 1.5 mm and 3 mm in 
horizontal and vertical directions, respectively, while with adaptive control scheme, the tracking 
quality is improved in the sense that the maximum deviation along the horizontal and vertical 
axes are reduced to 0.8 mm and 0.1 mm, respectively. Unlike the straight line case, faster 
adaptation occurs in the current study case as showed in the beginning of the path. 

Tracking a Circular Path 

Figure 8 presents the simulation results of tracking a circular path defined by the equaiton 
( x — 34) 2 + (y + 83) 2 = 16 [in cm]. Comparative evaluation of the results of the two applied 
control schemes shows that the steady-state errror is much smaller in the case of adaptive 
control scheme compared to the case of fixed-gain control scheme. In particular, the fixed gain 
and adaptive control schemes have a steady-state error of 3mm and 0.1mm, respectively in both 
horizontal and vertical axes. 

In the above simulation study, the control scheme parameters were set as follows: 

• Fixed-Gain Control Scheme: K Pl = K Pi = 3000 N/m and Kji = Kj 2 = 90 N.sec/m. 

• Adaptive Control Scheme: £, and a;,- for i= 1,2 were selected so that 2 characteristic roots 
axe both located at -10. Thus Di =10012 and D2=20l2. 

5 CONCLUSION 

A joint-space adaptive control scheme was developed in this report to control the motion of a 6 
DOF end-effector mounted to the slave arm of a telerobotic system to perform assembly tasks in 
the traded mode of a teleoperation. The adaptive control scheme consists of a proportional and 
a derivative time varying controllers designed by employing the concept of model reference adap- 
tive control and Lyapunov theorem. The joint-space adaptation scheme was derived under the 
assumption that the end-effector performs slow motion so that the end-effector mass matrix can 
be considered as nearly constant. Unlike other nonlinear control schemes for robot manipulators, 
the developed control scheme does not require the computation of the end-effector dynamics. 
Therefore this computationally efficient control scheme can be implemented in real-time control 
applications without the requirement of a super fast computer. Implementation of the devel- 
oped control scheme on a 2 DOF end-effector was investigated using computer simulation. We 
considered three different cases of path tracking: tracking a straight line, tracking a sinusoidal 
path, and tracking a circular path and compared the performance of the adaptive control scheme 
with a fixed-gain controller scheme. Simulation results showed that the adaptive control scheme 
provides better tracking performance with smaller steady-state errors than the fixed-gain con- 
trol scheme. Future research should be focused on the development of Cartesian-space adaptive 
control schemes and hybrid adaptive control schemes [15] and extend the developed adaptive 
control scheme to handle fast robot motion. 
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Figure 5: Implementation of the joint-space adaptive control scheme 



Figure 6: Computer simulation result for tracking a linear path 















